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Specification 

Title of the Invention: Operating Range Limiting Device for Manipulator 
Claims 

1 . A device for limiting, within a prescribed range, the motions of a manipulator, which 
comprises a slave side servo mechanism for implementing control such that, of the positioning 
signals indicating the position of each joint of an articulated master side manipulator and slave 
side manipulator having mutually corresponding joints, the positioning signals of the master side 
joints are treated as the target signals, and each slave side joint tracks each corresponding master 
side joint, and a master side servo mechanism for implementing control such that force signal 
displacements indicative of outside forces being applied to corresponding joints are treated as 
inputs, and an outside force applied to each slave side joint is transferred to each corresponding 
master side joint, [said] manipulator operating range limiting device being characterized in that 
there is provided for each set of corresponding joints of the master side and slave side a control 
system, comprising operating range detecting means for treating either one side or both sides of 
either one set or a plurality of sets of positioning signals of master side joints and slave side 
joints corresponding thereto as input positioning signals, storing thereinside an upper limit and a 
lower limit for determining an operating range corresponding to these input positioning signals, 
and when said input positioning signal exceeds either one of this upper limit or lower limit, 
turning ON a corresponding upper limit or lower limit switching signal; positioning signal 
switching means for updating and storing said target signals at each sampling when said upper 
limit and lower limit switching signals are both OFF, and when one of either said upper limit or 
lower limit switching signals is ON, holding a target signal stored at a sampling immediately 
prior to the point in time when this [signal turned] ON, and outputting [same] as a target signal 
of said slave side servo mechanism; reaction force generating means for generating a reaction 
force signal of a direction such that said input positioning signal returns to within said operating 
range when either said upper limit or lower limit switching signal turns ON; and force signal 
switching means for providing said reaction force signal as input to said master side servo 
mechanism in place of said force signal displacement when either of said switching signals turns 
ON. 



3 




Detailed Explanation of the Invention 
(Field of Application of the Invention) 

The present invention is related to an operating range limiting device for a manipulator, 
and more particularly to an operating range limiting device capable of limiting, to an appropriate 
range without losing operability, the operation of master-slave manipulators for implementing 
via remote control work that human workers cannot perform up close at nuclear power plants 
and the like. 

(Prior Art) 

A manipulator arm, as is widely known, is driven by joints, but the operating range 
thereof must be limited such that the arm does not collide with another mechanism element of 
the manipulator or another object. As a conventional example of such an operating range 
limiting mechanism for manipulator joints, there is, for example, Japanese Patent Laid-open No. 
53-17880. This mechanism is [disposed] inside a positioning control system for controlling the 
joint angles of the arm, and compares a target signal of a joint angle of the arm against a 
positioning signal indicating the boundary value of the operating range, and if the target signal 
exceeds this boundary value, implements positioning control such that the target signal is held at 
the current value, and the joint angles of the arm are stopped at the current position. However, 
the problem with this method is that, when a joint angle moves outside the operating range, 
restoration is difficult because no mechanism is provided for restoring and normally operating 
the joints of the arm in the operating range once again. 

Further, in the case of a master-slave manipulator, which is constituted such that the slave 
manipulator is operated remotely correspondent to the movements of the master manipulator by 
the manual operation of an operator, when a slave manipulator joint moves outside the operating 
range, the method whereby the operator is made aware of this by a lamp or the like on the control 
console is known. However, the problem with this method is that it is hard for an operator to 
figure out in what direction [the master manipulator] should be moved to get the joint to return to 
within the operating range while he is holding the tip of the master manipulator and operating it. 
In particular, when two or more of the joints move outside the operating range, restoring [these 
joints] to within the operating range becomes extremely difficult, making this problem even 
more serious. At the same time, another drawback is that the operator has to temporarily 
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discontinue working via remote control, and move his line of sight from the work-piece to a 
lamp or the like on the control console, causing operability to deteriorate. 

(Purpose of the Invention) 

An object of the present invention is to provide a master-slave manipulator operating 
range limiting device capable of easily and rapidly restoring the joint angles of a manipulator 
arm within the operating range when [these joint angles] move outside a pre-established 
operating range. 

(Summary of the Invention) 

The present invention is characterized in that functions, which, the instant either of the 
manipulator arms exceeds a pre-established operating range, stop the slave manipulator in that 
position, and simultaneously generate torque for moving the human-operated master manipulator 
in a direction toward the operating range, have been added, and, by sensing this torque as an 
impulsive force, the operator can easily detect the joint which exceeded the operating range, and 
the direction of operation for restoring this (joint within the operating range], thereby making it 
easy to restore each joint to the operating range. 

(Embodiments of the Invention) 

The embodiments of the present invention will be explained hereinbelow using the 
figures. Fig. 1 shows the overall constitution of a master-slave manipulator to which the present 
invention applies, and [this manipulator] is constituted from a master manipulator 1 and a slave 
manipulator 2 of mutually similar shapes, a controller 3, and a monitor television 4. The 
manipulators 1, 2 have a structure that resembles the arm of a human being, each having base 
portions 11,21, upper arms 13, 23 linked to the base portions 1 1, 21 by shoulder joints 12, 22 
located at the one end of the base portions, forearms 15, 25 linked to the upper arms 13, 23 by 
elbow joints 14, 24 located at the one end of the upper arms 13, 23, and wrist joints 16, 26 
located at the tips of the forearms. The top end of the base portion 1 1 of the master manipulator 
1 is linked to a frame 10, and the bottom end of the base portion 21 of the slave manipulator 2 is 
linked to a wheeled vehicle 20. A handle 17 comprising a finger portion is linked to the master 
wrist joint 16. A finger portion 27 is linked to the slave wrist joint 26. Manipulators 1 and 2, as 
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shown by the arrows in Fig. 1 and in Table 1, have seven degrees of freedom, Ml through M7 
and SI through S7. That is, Ml (SI) denotes the motion of the base portion 1 1 (21) relatively 
rotating around its central axis relative to the frame 10 (wheeled vehicle 20), and M2, M3 (S2, 
S3) denote the motions of the upper arm 13 (23) and forearm 15 (25) rotating in the vertical 
plane around the shoulder joint 12 (22) and elbow joint 14 (24), respectively. M4, M5, M6 (S4, 
S5, S6) denote rotation modes that enable the finger portion 17 (27) to assume arbitrary attitudes 
relative to the wrist joint 16 (26). M7 (S7) denotes the opening and closing motion of the fingers 
for grasping an object. 



Table 1 



No. 


Operating Part 


Master 


Slave 


I 


Base Rotation 


M, 


s, 


II 


Upper Arm Swing (Around Shoulder Joint) 


M 2 


s 2 


III 


Forearm Swing (Around Elbow Joint) 


M 3 


S3 


IV 


Wrist Up-Down Swing (PITCH) 


M» 


S 4 


V 


Wrist Left-Right Swing (YAW) 


M 5 


s 5 


VI 


Wrist Rotation (ROLL) 


Me 


s 6 


VII 


Finger Opening and Closing Motion (TONG) 


M 7 


s 7 



Summaries of the operating methods and motions of a manipulator such as this are as 
follows. An operator 5 positions and controls a slave manipulator 2 by operating a master 
manipulator 1 while watching an image of the slave manipulator 2 displayed on a monitor 
television 4. Namely, by the operator 5 grasping the handle 17 and moving the tip of the master 
manipulator 1 , the joints of the master manipulator move, and in line with this movement, the 
joints of the slave manipulator 2 track the joints of the master manipulator 1 . As a result, since 
the attitudes of the joints of the master manipulator 1 and slave manipulator 2 are maintained in 
mutually similar shapes, it is possible for the operator 5 to intuitively tell the attitude of the slave 
manipulator from the attitude of the master manipulator. At the same time, since forces being 
applied to the slave manipulator 2 from outside are detected by force sensors and the like, and 
fed back to the motors driving the joints of the master manipulator 1 , reaction forces . 
corresponding to the outside forces are generated for each joint. As a result of this, the operator 
5 can operate [the master manipulator 1] while feeling the forces acting on the slave manipulator 
2. 



6 




The joint control mechanisms for achieving operation such as that described hereinabove 
are controlled independently for each mutually corresponding joint system of the master and 
slave as shown in Fig. 2. That is, the control mechanism for the base rotation joint system is 
constituted from a master base rotation motor 31a, position detector 41a and force detector 51a 
of the master manipulator 1 side, a slave base rotation motor 31b, position detector 41b and force 
detector 51b of the slave manipulator 2 side, and a servo computing element 61 inside the 
controller 3. Similarly, the rest, from the upper arm swing joint system constituted from a master 
shoulder joint motor 32a, position detector 42a, and force detector 52a of the master side, a slave 
upper arm swing motor 32b, position detector 42b, and force detector 52b of the slave side, and a 
servo computing element 62 inside the controller 3, to the finger opening-closing joint system 
comprising a master finger opening-closing motor 37a, position detector 47a, and force detector 
57a of the master side, a slave finger opening-closing motor 37b, position detector 47b, and force 
detector 57b of the slave side, and a servo computing element 67 inside the controller 3, are of 
the same constitution. Although the external appearance of these joint control systems differs as 
shown in Fig. 1, the servo mechanisms, which constitute the basis of this control, are identical. 

The operating range controllers of the present invention are incorporated inside the 
above-mentioned servo computing elements 61 through 67, but since they are the same for all 
joint systems, [these controllers] will be explained here using the embodiment of the base 
rotation joint system shown in Fig. 3. In Fig. 3, the master side mechanism portion is constituted 
from a motor 31a, which is linked to the joint shaft by a transfer mechanism comprising a 
reduction gear not shown in the figure; a force detector 51a for detecting axial torque acting on 
the joint shaft; and a position detector 41a for detecting the angle of rotation of the joint shaft. 
Further, the slave side mechanism portion is constituted the same as that of the master side, and 
has a motor 31b, force detector 51b and position detector 41b, The circuits of Fig. 3 other than 
these mechanism portions belong to the servo computing element, and are constituted from a 
subtracter 1 13 for calculating the difference of output signals 203, 204 of force detectors 51a, 
51b; a subtracter 1 14 for subtracting a current position signal 201 and a slave position target 
signal 209; a PID control circuit 115; amplifiers 1 16a, 1 16b for driving the master side and slave 
side motors; and an operating range limiting circuit 127 (inside the chain line), which constitutes 
the present invention. Operating range limiting circuit 127 is constituted from an operating 
range detecting circuit 1 17; a reaction force generating circuit 1 19 of a gate circuit 1 18; a switch 
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120a for switching an output signal 210 of the reaction force generating circuit 1 19 and a force 
displacement signal 205; a switch 120b for switching a master current position signal 200 and a 
signal 209b that latches a slave target signal; and a latching circuit 121 for latching a slave target 
signal 209. 

Operating range detecting circuit 1 17 is constituted from a memory 122a for stipulating 
the upper limit of an operating range as shown in Fig. 4; a memory 122b for stipulating the lower 
limit thereof; and comparators 123a, 123b for comparing each of an upper limit signal 21 1 and 
lower limit signal 212 outputted from these respective memories against a master current 
position signal 200. Reaction force generating circuit 1 19 is constituted from memories 124a, 
124b for stipulating the size of a reaction force acting in the direction of within the operating 
range as shown in Fig. 5; switches 125a, 125b for switching ON and OFF the output of the 
respective output signals 213, 214 thereof; and an adder 126 for adding the output signals of 
these switches. 

The operation of the joint systems shown in Fig. 3 through Fig. 5 will initially be 
explained hereinbelow based on the operation of a force feedback-type bilateral servo system. 
The positions of the master side joint angles and the positions of the slave side joint angles are 
respectively detected by position detectors 41a, 41b as current position signals 200, 201, and are 
converted to a position displacement signal 202 via subtracter 1 14 ([Switch] 120b selects signal 
200 at this time). Position displacement signal 202 is inputted to motor 3 lb by way of PID 
control circuit 1 15 and amplifier 1 16b. By so doing, motor 31b operates, position signal 210 
changes, and position displacement signal 202 is eventually controlled so as to constitute 0. 
Consequently, when an operator manipulates the master side joints, the slave side joints are 
positioned and controlled so as to move by tracking the master side joints. 

At the same time, forces applied from outside to the master side and slave side are 
detected by respective force detectors 41a, 41b as current torque signals 203, 204, and are 
converted to a torque displacement signal 205 via subtracter 113. Torque displacement signal 
205 is inputted to motor 31a by way of switch 120a and amplifier 1 16a. Therefore, motor 31a is 
controlled such that torque displacement signal 205 becomes 0. As a result of this, a force 
applied to the slave side from outside is transferred to the master side, and the operator can feel 
the force being applied to the slave side in the form of a reaction force. 
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Next, the operation of the operating range limiting device, which forms the essential part 
of the present invention, will be explained. The upper limits and lower limits of the operating 
ranges of the master side joint angles (the boundary values of each operating range) are written 
into each of memories 122a, 122b of Fig. 4 beforehand, these output signals 21 1, 212 are 
inputted into comparators 123a, 123b, and the current position signals 200 of the master side 
joints are inputted into comparators 123a, 123b. When a master side current position signal 200 
is greater than the upper limit signal 21 1, the logic signal 206 of comparator 123a constitutes 1 . 
When it is anything else, [the logic signal] remains 0 as-is. Similarly, when a master side current 
position signal 200 is less than the lower limit signal 212, the logic signal 207 of comparator 
123b becomes 1, and when it is anything else, [this logic signal] remains 0 as-is. These logic 
signals 206, 207 are inputted into the reaction force generating circuit shown in Fig. 5, and when 
the master side joints are within the operating range, they are used as the gate signals of switches 
125a, 125b, which cut off the reaction force signals 213, 214. Further, logic signals 206 and 207 
are used as gate signals 208 of switches 120a, 120b by way of OR circuit 1 1 8 of Fig. 3. If the 
master side joint angles are within the operating range, logic signals 206, 207, which are the 
outputs of operating range detecting circuit 1 17, are both in the 0 state as described hereinabove, 
gate signal 208, which is the output of OR circuit 1 18, is also in the 0 state, switch 120a makes 
torque displacement signal 205 its output signal 215, and switch 120b makes the master current 
position signal 200 the slave target position signal 209, which is its output. As a result of this, 
the above-mentioned force feedback-type bilateral servo system is constituted as the overall 
servo system, and the manipulator is in a normal operating state. However, if a master joint 
angle exceeds the upper limit of the operating range, logic signal 206 becomes 1, and gate signal 

208 also constitutes the 1 state. At this time, switch 120b cuts off master current position signal 
200, and outputs the output signal 209b of latching circuit 121. This output signal 209b latches 
the value of the slave target position signal 209 immediately prior to the master joint having 
moved outside the operating range, and since it is outputted as the slave target position signal 

209 until the master joint returns within the operating range and gate signal 208 becomes 0, the 
slave side joint is positioned and controlled so as to stop at the current position (the position 
immediately prior to the master joint having moved outside the operating range), and the slave 
joint does not move outside the operating range. Since logic signal 206 becomes 1 at the same 
time, switch 125a inside the reaction force generating circuit 119 transitions to the ON state (Fig. 
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5), and reaction force command signal 213 is outputted via adding circuit 126 as the output 
signal 210 of reaction force generating circuit 119. Then, as a result of gate signal 208 becoming 
1, switch 120a cuts off torque displacement signal 205, and outputs reaction force command 
signal 210 as a torque command signal 215. Consequently, master side motor 31a is controlled 
such that a constant torque is generated in the direction of the operating range until the master 
side joint is once again within the operating range. Therefore, by sensing this torque, an operator 
can readily manipulate [the master manipulator] in the restoration direction (For example, easing 
up on his force, and moving [the master manipulator] in the direction in which it is naturally 
moving in accordance with the torque.). Since processing is exactly the same when a master side 
joint exceeds the lower limit of the operating range, this explanation will be omitted. 

The effects according to this embodiment are that, when a master side joint moves 
outside the operating range stipulated by the master side joint angle, the slave side joint is 
automatically prevented from moving outside the appointed operating range, and [the master side 
manipulator] can also be easily manipulated so that the master side joint returns within the 
operating range. Further, as a variation of the present invention, the same effects can be obtained 
even if [the present invention] is constituted such that the slave side joint current position signal 
201 is utilized in place of the master side joint current position signal 200 as the input signal of 
the operating range detecting circuit 117 shown in Fig. 4. 

Fig. 6 shows another embodiment of the operating range detecting circuit 117 of Fig. 3, 
and by adding memories 122c, 122d for stipulating the upper limit and lower limit of the 
operating range of the slave side joints, comparators 123c, 123d, and OR circuits 128a, 128b to 
the circuit of Fig. 4, and adding the slave side joint current position signal 201 as an input signal, 
the constitution is such that, if either one of the master side or slave side joints is outside the 
operating range, the slave side joint is made to stop as described hereinabove, and at the same 
time, a reaction force is generated in the direction of the operating range in the master side joint. 
The effect according to this embodiment is that, even if the analogous relationship of the 
positions of the master side and slave side should break down for some reason or another, when 
any joint, regardless of whether it is on the master side or the slave side, is outside of the 
operating range, it can readily be restored therewithin. 
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The above embodiments are premised on the fact that the operating modes Ml through 
Mr (SI through Sr) described in Table 1 are controlled independently, but a plurality of these 
modes can also be taken into consideration and controlled. Fig. 7 shows another embodiment of 
the present invention, and [this embodiment] replaces the operating range detecting circuit 117 
shown in Fig. 3 with the processing unit 140 shown in Fig. 7, and has as an object the limiting of 
operating mode M2 (S2). Processing unit 140 is constituted from a coordinate computing unit 
141, space differential computing units 142a, 142b, logic operation units 143a, 143b, and OR 
circuits 144a, 144b. The input signal for the processing unit 140 is not only the output signal 20 
of either shoulder joint position detector 42a or 42b, but the elbow joint position signal 221 is 
also treated as input, and the output signals thereof, the same as in Fig. 3, are logic signal 242 
(corresponds to signal 206), which indicates that [a joint] has exceeded the upper limit of the 
operating range, and logic signal 244 (corresponds to signal 207), which indicates that [a joint] 
has exceeded the lower limit thereof. 

The operation of each part will be explained hereinbelow. Firstly, if the centers of 
rotation of the shoulder joint 12 (22), elbow joint 14 (24) and wrist joint 16 (26) of Fig. 1, 
respectively, are treated as the pivot point of the shoulder joint 310, the pivot point of the elbow 
joint 312, and the pivot point of the wrist joint 314 as shown in Fig. 8, these three points are 
constantly within the same perpendicular plane 300 (This perpendicular plane 300 rotates in 
accordance with either base rotation Ml or SI described in Table 1.). Accordingly, it is assumed 
that a rectangular coordinate system [lies] on this perpendicular plane 300, wherein the shoulder 
joint pivot 310 is treated as the origin (similarly called 310), a straight line, which extends from 
this origin 310 toward the elbow joint pivot 312 when the current position signal 220 of the 
shoulder joint is zero, is treated as the positive X-axis direction, and the direction in which this 
positive X-axis direction is rotated 90 degrees in the counterclockwise direction having origin 
310 as the center is treated as the positive Y-axis direction. In general, then, shoulder joint 
position signal 220 is furnished by the angle 0i formed by the X-axis and a straight line 313 
linking the elbow joint pivot 312 and origin 310. Further, when the position signal 221 of the 
elbow joint is zero, once the initial condition for the wrist joint pivot 314 extending to straight 
line 313 has been determined, position signal 221 is generally furnished by the angle 62 formed 
by straight line 313 and a straight line 315 linking the elbow joint pivot 312 to the wrist joint 
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pivot 314. Then, the coordinates (X R , Y R ) of the wrist joint pivot 314 relative to the rectangular 
coordinate system (X, Y) of Fig. 8 are as follows: 

X R = Si cos 0i + 5 2 cos (0i + 9 2 ) 
Y R = 5i sin 0i + 8 2 sin (0i + 0 2 ) ...(1) 

Here, 5i, 52 are the distances between point 3 1 0 and point 312, and point 3 12 and point 
314, and these are fixed lengths equivalent to the lengths of the upper arm 13 (23) and forearm 
15 (25) of Fig. 1. Therefore, computations based on the above equation are carried out by the 
coordinate computing unit 141 of Fig. 7 using Gi, 0 2 , which are furnished by input signals 220, 
221, and signal 240a, which corresponds to X R , and signal 240b, which corresponds to Y R , are 
outputted. 

In the space differential computing units 142a, 142b, the differential values of 
coordinates Xr, Y r as they relate to shoulder joint 0i 

cX R /a0i = - {(5i sin 0j + 5 2 sin (0i + 0 2 )} ... (2) 
aY R /a0i = 8i cos 0i + 8 2 cos (0i + 0 2 ) ...(3) 

are calculated using input signals 220 (0i), 240a (X R ) and 240b (Yr), and are outputted as signals 
250a, 250b. 

A logic operation is executed in logic operation unit 143a by inputting 240a, 250a, which 
correspond to X R , oX R /c0i, and, as shown in Table 2, logic signals 246a, 248a are outputted. It 
is supposed that the upper limit of the operating range of the X coordinate X R of the wrist joint is 
X u? and the lower limit is X L . 
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Table 2 



Input Conditions 


Output 


X R Range 


gXr/oGi Range 


246a 


248a 


l)Less than X L 


Positive 


0 


1 


2) Less than Xl 


Negative 


1 


0 


3) Between X L and Xu 


Optional 


0 


0 


4) Greater than Xu 


Positive 


1 


0 


5) Greater than Xu 


Negative 


0 


1 



The significance of logic outputs 246a, 248a such as these is as follows. Of the input 
conditions, oXr/gGi > 0 indicates a state wherein when 9i increases, Xr also increases, and 
gXr/gGi < 0 indicates the reverse thereof. Therefore, in the case of 1) in Table 2, for example, 
since Xr is less than lower limit Xl, signal 248a, which increases Oi, is set to 1 in order to 
increase Xr. This is the same operation as when 9i is increased by setting signal 207 to 1 in 
circuit 1 17 of either Fig. 4 or Fig. 6 (when 9i has exceeded the lower limit). Similarly, in the 
case of 2) in Table 2, signal 246a, which decreases 9 j, is set to 1 in order to increase X R . This 
corresponds to when signal 206 of Fig. 4 and Fig. 6 is set to 1 (when 9i has exceeded the upper 
limit). No limiting operation is carried out in the case of 3). The operations for 4) and 5) are the 
same as those for 1) and 2). 

The same processing as that of logic operation unit 143 a is carried out in logic operation 
unit 143b for the operating range of the Y coordinate of the wrist joint (Yl < Y < Yu), and logic 
signals 246b, 248b are outputted for the same reasons. Then, the logic sums of signals 246a, 
246b and 248a, 248b are derived via the respective OR circuits 144a, 144b, and are outputted as 
signals 242, 244. 

The final output signal 242 of the numerical processing unit 140 is used as the upper limit 
logic signal 206 of Fig. 3, and similarly, signal 244 is used as the lower limit logic signal 207. 
The operations of the other circuits are the same as those explained for Fig. 3. As a result, the 
position of the wrist joint will have a rectangular area such as that shown in Fig. 9 as the 
operating range, and the operation of rotation modes M2, M3 (S2, S3) of Table 1 can be 
synthetically limited. 
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According to this embodiment, it is possible to control the operating range of the position 
of the wrist joint within an arbitrary rectangular area by appropriately setting X L , Xu, Y L , and Yu, 
and by combining this embodiment with the embodiment shown in Fig. 3, for example, it is also 
possible to control the operating range of a manipulator within an area 50 such as that indicated 
by the diagonal lines in Fig. 10. That is, [the present invention] can be constituted such that the 
circular arc-shaped area boundaries of Fig. 10 are created by controlling the angles Gi, 62 of the 
joints (See Fig. 8) using separate upper and lower limit values for each as in the embodiment of 
Fig. 3, and at the same time, the linear area boundary of Fig. 10 is created by converting [these 
angles] to rectangular coordinates, and controlling these using OR conditions (control when 
either boundary is exceeded) as in the embodiment of Fig. 7. Furthermore, a servo computing 
element comprising either an operating range detecting circuit 1 17 like the above, or the 
processing unit of Fig. 7, can be easily achieved using a microcomputer or the like. 

(Effects of the Invention) 

As is evident from the above explanation, according to the present invention, since an 
operator manipulating a master manipulator can be taught, in the form of a reaction force, that a 
joint is outside the operating range, and can automatically restore each of the manipulator's joints 
to within the operating range by virtue of this reaction force, the effects are that returning the 
manipulator to the operating range becomes easy, and the need to discontinue manipulator 
operation is eliminated, thus enabling manipulator operability to be greatly enhanced, and since 
it is possible at the same time to prevent accidents resulting from a manipulator operating outside 
its operating range, another significant effect is the enhancement of manipulator reliability. 

Brief Explanation of the Drawings 

Fig. 1 is a diagram showing the overall constitution of a master-slave manipulator to 
which the present invention applies; Fig. 2 is a block diagram of the control system in Fig. 1; Fig. 
3 is a diagram showing an embodiment of the present invention; Fig. 4 and Fig. 5 are partial 
detailed views of the embodiment of Fig. 3 in more detail; Fig. 6 and Fig. 7 are diagrams 
showing other embodiments of the present invention; Fig. 8 and Fig. 9 are diagrams illustrating 
the operation of the embodiment of Fig. 7; and Fig. 10 is a diagram showing the operating range 
when the embodiments of Fig. 3 and Fig. 7 have been combined. 
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1 ... MASTER MANIPULATOR, 2 ... SLAVE MANIPULATOR; 3 ... CONTROLLER; 12, 
22 ... SHOULDER JOINTS; 14, 24 ... ELBOW JOINTS; 16, 26 ... WRIST JOINTS; 31a, 31b ... 
MOTORS; 41a, 41b ... POSITION DETECTORS; 51a, 51b ... FORCE DETECTORS; 117 ... 
OPERATING RANGE DETECTING CIRCUIT; 1 18 ... OR GATE; 1 19 ... REACTION FORCE 
GENERATING CIRCUIT; 120a, 120b ... SWITCHES; 121 ... LATCHING CIRCUIT; 127 ... 
OPERATING RANGE LIMITING CIRCUIT. 

Representative: Patent Attorney Masami Akimoto (as transliterated) 

Fig.l 
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